APPENDIX D 



/* QRD * 

/include <stdlib.h> 
/include <math.h> 

/define TRUE 1 

/define FALSE 0 

/define FLOAT 3 2 float 

/define INT32 long int 

/define VOID void 

/define FABSF fabs 

/define SQRTF sqrt 



typedef struct { 

INT3 2 dummy; 
} LQRDJPEF_CONTEXT; 

typedef LQRDJPEF_CONTEXT * LQRDJPEF_Handle; 

extern LQRDJPEF_Handle 
LQRDJPEF_Init ( 

INT32 NumCells, 

FLOAT32 Lambda, 

FLOAT 3 2 SumErr Init , 

FLOAT3 2 Gamslnit, 

FLOAT 3 2 MinSumErr) ; 



extern VOID 
LQRDJPEFDone ( 

LQRDJPEF_Handle hJPE) ; 

extern VOID 
LQRDJPEF_Reset ( 

LQRDJPEF_Handle hJPE) ; 

extern FLOAT 3 2 

LQRDJPEF_Calc( 

LQRDJPEF_Handle hJPE, 
FLO AT 3 2 nps, 
FLOAT 3 2 noise); 



/* handle 

/* noise plus signal 
/* noise reference 



/define MAX(a,b) (a) > (b) ? (a) : (b) 
/define MIN(a,b) (a) < (b) ? (a) : (b) 



/define LQRD JPEF_CELL_SI ZE 27 
typedef struct { 



FLOAT 3 2 


sinf , 


sinf_ 


1 


} 


FLOAT3 2 


sinb , 


sinb_ 




i 


FLOAT 3 2 


cosf , 


cosf_ 


1 


• 

f 


FLO AT 3 2 


cosb , 


cosb_ 


V 


* 

/ 



FLO AT 3 2 epsf; 



FLOAT32 epsb , epsb_l 



FLOAT 3 2 pief , pief_l ; 

FLOAT 3 2 pieb , pieb_l ; 

FLO AT 3 2 Fserr, Fserr_l, SQRTF_Fserr , SQRTF_Fserr_l ; 

FLOAT3 2 Bserr_l, Bserr_2 , SQRTF_Bserr_l , SQRTF_Bserr_2 ; 

FLO AT 3 2 p_l, p_2; 

FLOAT 3 2 gams_l; 

FLOAT 3 2 epsi_l; 



} LQRDJPEF CELL; 



typedef 



{ 



} 

/* 



struct 
INT3 2 
FLO AT 3 2 
FLOAT32 
FLOAT32 
FLOAT32 
FLOAT32 
FLOAT32 
LQRDJPEF_CELL 
LQRDJPEF_Context ; 

The following macros provide efficient access to the lattice 

Define variables offsets within structure 



NumCells; 


/* 


number 


of cell 


s 




* 


Lambda ; 


/* 


Lambda 








* 


SumErrlnit; 


/* 


Initial 


value 


for 


Fserr, Bserr 


* 


Gamslnit; 


/* 


Initial 


value 


for 


gams 


* 


MinSumErr; 


/* 


Minimum 


for Fserr, 


Bserr 




SQRTF_Lambda ; 


/* 


square 


root of 


Lambda 




SQRTF_SumErrInit 


;/* 


square 


root of 


SumErrlnit 




*cells; 


/* 


point to array 


of 


JPE_CELLS 





/define xSINF 
/define xSINF_l 
/define xSINB 
/define xSINB_l 

/define xCOSF 
/define xCOSF_l 
/define xCOSB 
/define xCOSB_l 

/define xEPSF 
/define xEPSB 
/define xEPSB_l 

/define xPIEF 
/define xPIEFl 
/define xPIEB 
/define xPIEB 1 



0 
1 

2 
3 

4 
5 
6 
7 

8 
9 

10 

11 
12 
13 
14 



/define xFSERR 15 

/define xFSERR_l 16 

/define xSQRTF_FSERR 17 

/define xSQRTF_FSERR_l 18 

/define xBSERR_l 19 

/define xBSERR_2 20 

/define xSQRTF_BSERR_l 21 

/define xSQRTF BSERR 2 22 



/define xpl 
/define xp 2 



23 
24 



#def ine 


xGAMSQ 1 




25 




#define 


XEPSI_1 




26 
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#def ine 
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(*(ptr 


+ 


#def ine 
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+ 


#def ine 
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+ 
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sinb 
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i 


#def ine 


sinb_l 
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+ 


/define 


P_sinb 
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+ 


/define 


P_sinb_l 




(*(ptr 


+ 
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f aei xne 
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/define 


cosf_l 
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+ 


/define 


P_cosf 




(*(ptr 


+ 


/define 


P_cosf_l 




(*(ptr 


+ 


#aet me 


cosb 




(* (ptr 


+ 


/define 


cosb_l 




(*(ptr 


+ 


/define 


P_cosb 




(*(ptr 


+ 


W uer ine 
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(* (ptr 


i 

T 


/define 


epsf 




(* (ptr 




/define 


P__epsf 
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+ 
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1 

T 


/define 


epsbl 
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+ 


/define 


P_epsb 
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/define 
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T 


/define 


pief_l 
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+ 


/define 


P pief 
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+ 


/define 


Pj?ief__l 
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+ 


/define 


pieb 




(*(ptr 


+ 


/define 


pieb_l 




(*(ptr 


+ 


/define 


P_pieb 




(*(ptr 


+ 


/define 


P_pieb_l 




(*(ptr 


+ 


/define 


Fserr 




(*(ptr 


+ 


/define 


Fserr_l 




(* (ptr 




/define 


P_Fserr 




(*(ptr 


+ 


/define 


P_Fserr_l 
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+ 


jruei xne 


SQRTF_Fserr 
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I 

T 


/define 


SQRTF Fserr 


1 


(*(ptr 


+ 


/define 


SQRTF_P_Fserr 


(*(ptr 


+ 


/define 


S QRT F_P_Fs e r r_ 


1 (*(ptr 


+ 


/define 


Bserr_l 




(* (p tr 


+ 


/define 


Bserr_2 




(*(ptr 


+ 


/define 


P_Bserr_l 




(*(ptr 


+ 


/define 


P_Bserr_2 




(*(ptr 


+ 


/define 


SQRTF_Bserr 


1 


(*(ptr 


+ 


/define 


SQRTF Bserr" 


~2 


(*(ptr 


+ 


/define 


SQRTF_P_Bserr 


1 (*(ptr 


+ 


/define 


SQRTF_P_Bserr_ 


2 (*(ptr 


+ 



XSINF) ) 
XSINF_1) ) 

XSINF - LQRD JPEF_CELL_S I Z E ) ) 
XSINF_1 - LQRDJPEF_CELL_S I Z E ) ) 

XSINB) ) 
XSINB_1) ) 

XSINB - LQRD JPEF_CELL_S I Z E ) ) 
XSINB1 - LQRDJPEFCELLSIZE) ) 

XCOSF) ) 
XCOSF1) ) 

XCOSF - LQRDJPEF_CELL_SIZE) ) 

xCOSF_l - LQRDJPEFCELLSIZE) ) 

XCOSB) ) 
XCOSB1) ) 

XCOSB - LQRDJPEF_CELL_SIZE) ) 

xCOSB_l - LQRDJPEF_CELL_SIZE) ) 

XEPSF) ) 

XEPSF - LQRDJPEF_CELL_SIZE) ) 

XEPSB) ) 
XEPSB1 ) ) 

XEPSB - LQRDJPEF_CELL_SIZE) ) 
XEPSB_1 - LQRDJPEF_CELL_SIZE) ) 

XPIEF) ) 
XPIEF_1) ) 

XPIEF - LQRDJPEF_CELL_SIZE) ) 
XPIEF_1 - LQRDJPEF_CELL_SIZE) ) 

XPIEB) ) 
XPIEB_1) ) 

XPIEB - LQRDJPEF_CELL_SIZE) ) 
XPIEB_1 - LQRDJPEFCELLSIZE) ) 



XFSERR) ) 
XFSERR1) ) 

XFSERR - LQRDJPEF_CELL_SIZE) ) 
XFSERR1 - LQRDJPEFCELLSIZE) ) 
XSQRTF_FSERR) ) 
XSQRTF_FSERR_1) ) 

XSQRTF_FSERR - LQRDJPEF_CELL_SIZE) ) 
XSQRTF_FSERR_1 - LQRDJPEF_CELL_SIZE) ) 

xBSERR_l) ) 
xBSERR_2) ) 

XBSERR_1 - LQRDJPEF_CELL_SIZE) ) 
XBSERR_2 - LQRDJPEFCELLSIZE) ) 
xSQRTFBSERRl) ) 
XSQRTFBSERR2 ) ) 

XSQRTFBSERRl - LQRDJPEF_CELL_SIZE) ) 
XSQRTFBSERR 2 - LQRDJPEF_CELL_SIZE) ) 



/define p_l 
/define p JZ 
/define P_p_l 
/define P_p_2 

/define gams_l 
/define P__gams_l 

/define epsi_l 
/define P_epsi_l 

static FLOAT32 
RSQRTF ( 

FLOAT 3 2 X) { 



(*(ptr + xp_l)) 
(*(ptr + xp_2)) 
(* (ptr + xp_l 
(* (ptr + xp_2 



- LQRDJPEF_CELL_SIZE) ) 

- LQRDJPEF_CELL_SIZE) ) 



(*(ptr 
(*(ptr 

(*(ptr 
(*(ptr 



+ XGAMSQ_1) ) 

+ XGAMSQ_1 - LQRDJPEF_CELL_SIZE) ) 
+ XEPSI_1)) 

+ xEPSIJL - LQRDJPEF__CELL_SIZE) ) 



return 1.0F / SQRTF(x) ; 



Name : LQRDJPEF_Init 

Abstract : Create a JPE context 



extern LQRDJPEF_Handle 

LQRDJPEF_Init( 

INT3 2 NumCells, 

FLO AT 3 2 Lambda, 

FLOAT 3 2 SumErrlnit, 

FLOAT 3 2 Gamslni t , 

FLOAT 3 2 MinSumErr) { 



LQRDJPEF_Context *jpe; 

jpe = malloc (sizeof (LQRDJPEF_Context) ) ; 
assert(jpe != NULL); 

jpe->NumCells = NumCells; 

jpe->Lambda = Lambda; 

jpe->SumErrInit = SumErrlnit; 

jpe->GamsInit = Gamslnit; 

jpe->MinSumErr = MinSumErr;* 

jpe->SQRTFJLambda = S£RTF( jpe->Lambda) ; 

jpe->SQRTF_SumErrInit = SQRTF ( jpe->SumErrInit) ; 

jpe->cells = malloc (sizeof (LQRDJPEF_CELL) * (NumCells + 2)); 
assert (jpe->cells != NULL) ; 

LQRDJPEF_Reset ( (LQRDJPEF_Handle) jpe) ; 
return ( (LQRDJPEF Handle) jpe) ; 

} 



/* 

Name : LQRDJPEF_Done 

Abstract : Delete a JPE context 



extern VOID 
LQRDJPEFDone ( 



} 

/* 



LQRDJPEF_Handle hJPE) { 

LQRDJPEF_Context *jpe = (LQRDJPEF_Context *)hJPE; 

free ( jpe->cells) ; 
free(jpe); 



Name : LQRDJPEF_Reset 

Abstract : Reset a JPE context 



extern VOID 
LQRDJPEF_Reset( 

LQRDJPEF Handle 



hJPE) { 



LQRDJPEF_Context *jpe = ( LQRD JPEF_Cont ext *)hJPE; 



FLO AT 3 2 
INT32 



*ptr; 
m; 



ptr = ( FLOAT 3 2 *) jpe->cells; 

for (m = 0; m <= jpe->NumCells; m++) { 

sinf = O.OF; 

sinb = O.OF; 

cosf = o.OF; 

cosb = O.OF; 

epsf = O.OF; 

epsb = O.OF; 

pief = O.OF; 

pieb = O.OF; 

p_l = O.OF; 

Fserr = jpe->SumErrInit; 

Bserrl = jpe->SumErrInit; 

gams_i = jpe->GamsInit ; 

SQRTF_Fserr = jpe->SQRTF_SumErrInit ; 

SQRTF_Bserr_l - jpe->SQRTF_SumErrInit ; 



ptr 

} 



+= LQRDJPEF_CELL_SIZE; 



ptr = (FLOAT32 *) jpe->cells; 
gamsl = l.OF; 



/* Cell # o special case 



Name 

Abstract 



LQRDJPEF Calc 



extern FLOAT3 2 
LQRDJPEF_Calc( 

LQRDJPEF_Handle hJPE, 

FLOAT 3 2 nps, /* noise plus signal */ 

FLOAT 3 2 noise) { /* noise reference */ 

LQRDJPEFContext *jpe = ( LQRD JPEF_Cont ext *)hJPE; 



INT32 



m; 



FLO AT 3 2 *ptr; 
FLOAT 3 2 tmp; 

Time update section 

Ptr = (FLO AT 3 2 *) jpe->cells; 

for (m = 0; m <= jpe->NumCells; m++) { 

/* some of following delay elements are not needed */ 

sinf_i = sinf; 

sinbl = sinb; 

cosf_i = cosf; 

cosb_l = cosb; 

epsbl = epsb; 

piefl = pief ; 

piebi = pieb; 

Fserr_l = Fserr; 
Bserr_2 = Bserr_l; 
P_ 2 = p_i; 

SQRTF_Bserr_2 = SQRTF_Bserr 1 ; 
SQRTF_Fserr_l = SQRTF_Fserr; 

ptr += LQRDJPEF__CELL_SIZE; 



/* Order update section */ 
/* Handle Cell #0 */ 

ptr = (FLOAT32 *) (jpe->cells) ; /* point to cell # 0 */ 
epsf = noise; 
epsb = noise; 
epsi_l = nps; 

/* rest of cells */ 

for (m = l; m < jpe->NumCells; m++) { 

ptr += LQRDJPEF_CELL_SIZE; /* access next cell */ 

/* Prediction section */ 

P_Bserr_l = jpe->Lambda * P_Bserr_2 + P epsb 1 * p epsb 1 
P_Bserr_l = MAX (P_Bserr_l , jpe->MinSumErr) ; ~ 
SQRTF_P_Bserr_l = SQRTF(P_Bserr_l) ; 

tmp = RSQRTF (P_Bserr_l) ; /* this comes free on DSP */ 

P_cosb_l = jpe->SQRTF_Lambda * SQRTF_P_Bserr_2 * tmp; 

P_sinb_l = P_epsb_l * tmp; 

tmp = jpe->SQRTF_Lambda * P_pief_l; 

epsf = P_cosb_l * P_epsf - P_sinb_l * tmp; 

P_pief = P_cosb_l * tmp + P sinb l * P epsf; 

gamsi = P_cosb_l * Pgams 1; 



} 



I'llm - MA?7» L ?" bda *. P - Fserr _l + P_epsf * P epsf; 
- Serr ~ MAX(P_Fserr, jpe->MinSumErrT; ~ 

SQRTF_P_Fserr = SQRTF ( P Fserr) ; 

tap = RSQRTF (P_Fserr) ; /* this comes free on DSP */ 
P_cosf = jpe->SQRTF_Lambda * SQRTF_P_Fserr_l * tmp; 
P_sinf = P_epsf * tmp; 

tmp = jpe->SQRTF_Lambda * p pieb l- 

epsb = Pcosf * P_epsbj - p_s inf * tmp; 

P_pieb = P_cosf * tmp + P_sinf * Pepsbl; 

/* Joint Process Estimation section */ 

tmp = jpe->SQRTF_Lambda * p_ p 2 - 

epsi_i = P _cosb_l * P_epsO'- P_sinb_l * tmp; 
P _P_1 = P_cosb_l * tmp + P_sinb_l * Pepsil; 



Ptr += LQRDJPEF_CELL_SIZE; /* access next cell */ 
oni^ i I ilnUin wor \ for JPE of very last cell 

only four equations are required for prediction section , 

l-TstVA : ^x7p L Bserr ? P ^ Ser ^ 2 + *-*PS»_l * p e psb 1; 
_ MAX(P_Bserr_i, Dpe->MmSumErr) ; ~ ~ 

SQRTF_P_Bserr_l = SQRTF (P Bserr 1) • 

tmp = RSQRTF (P_Bserr_l) ; J* this comes free on DSP */ 
P_cosb_l = jpe->SQRTF_Lambda * SQRTF_P_Bserr_2 * tmp; 
P_sinb_i = P_epsb_l * tmp; 

/* Joint Process Estimation for last cell */ 
tmp = jpe->SQRTF_Lambda * P_ p 2 - 

e P si_i = P_cosb_i * P_epsO / - P sinb i * tmp; 
P_p_l = P_cosb_l * tmp + P_sinb_l * P_epsi_l; 

gams_l = P_cosb_l * P_gams_l; 
return(gams_l * epsi_i) ; 



